Navy Case No. 95902 



GLIDING VEHICLE GUIDANCE 

RELATED APPLICATIONS 

The present patent application is a divisional of the previously filed and 
coassigned patent application, entitled "Gliding Vehicle Guidance," filed on June 21, 
5 2002, and assigned serial no. 10/175,527 (attorney docket no. 83272). 

FIELD OF THE INVENTION 

This invention relates generally to gliding vehicles, such as rockets, missiles, 
aircraft, and projectiles, and more particularly to guiding such gliding vehicle. 

BACKGROUND OF THE INVENTION 

10 Atmospheric vehicles that can glide, or that otherwise have significant glide 

phases, include rockets, missiles, aircrafts, and projectiles. Typically, such vehicles are 
controllable so that they reach a desired target or destination. They may be controlled by 
a guidance algorithm. Existing compact closed-form guidance algorithms for gliding 
flight maximize the range and cross-range while satisfying the aimpoint and final velocity 

15 orientation requirements. Compact, closed form algorithms exist to control the time-of- 
flight of powered vehicles but such algorithms for gliding vehicles have previously been 
unavailable. To achieve range and cross-range maximization, as well as time-of-flight 
control for gliding vehicles, open-loop or perturbation feedback algorithms may be 
utilized. However, such algorithms are expensive to design for a particular application, 

20 and are furthermore not robust to airfi-ame and environment variations. For these and 
other reasons, therefore, there is a need for the present invention. 
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SUMMARY OF THE INVENTION 

The invention relates to guiding a gliding vehicle. A method of the invention 
allows the range of the glide phase of a gliding vehicle to be maximized, while satisfying 
final flight path angle and aimpoint requirements. The method may also control the time- 
5 of-flight of the gliding value to a desired value, while satisfying final flight path angle 
and aimpoint requirements. The time-of-flight control can correct for winds, off-nominal 
launch conditions, and rocket motor variations, among other factors. Both time-of-flight 
control and range and cross-range maximization can be achieved by the inventive 
method, utilizing a compact closed-loop approach. 

10 The method provides a unified generic structure that is able to accommodate a 

wide variety of mission profiles. The method is easily implemented in missile flight 
hardware in particular, and easily optimized by a designer for a particular application. 
Because the method is closed loop, it is robust as well. Still other aspects, advantages, 
and embodiments of the invention will become apparent by reading the detailed 

1 5 description that follows, and by referencing the accompanying drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS 

The drawings referenced herein form a part of the specification. Features shown 
in the drawing are meant as illustrative of only some embodiments of the invention, and 
not of all embodiments of the invention, unless otherwise explicitly indicated, and 
20 implications to the contrary are otherwise not to be made. 

FIG. 1 is a flowchart of a method for guiding a gliding vehicle, according to an 
embodiment of the invention. 
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FIG. 2 is a graph illustrating example time-of- flight control trajectories, according 
to an embodiment of the invention. 

FIG. 3 is a graph illustrating an example time-of-flight bias history, according to 
an embodiment of the invention. 
5 FIG. 4 is a block diagram of a gliding vehicle, according to an embodiment of the 

invention. 

DETAILED DESCMPTION OF THE INVENTION 

In the following detailed description of exemplary embodiments of the invention, 
reference is made to the accompanying drawings that form a part hereof, and in which is 

10 shown by way of illustration specific exemplary embodiments in which the invention 
may be practiced. These embodiments are described in sufficient detail to enable those 
skilled in the art to practice the invention. Other embodiments may be utilized, and 
logical, mechanical, and other changes may be made without departing from the spirit or 
scope of the present invention. For example, whereas the invention is substantially 

15 described in relation to a missile, it is applicable to other types of gliding vehicles as well. 
The following detailed description is, therefore, not to be taken in a limiting sense, and 
the scope of the present invention is defined only by the appended claims. 

FIG. 1 shows a method 100 for guiding a gliding vehicle, according to an 
embodiment of the invention. The method 100 may be implemented as a computer 

20 program within a controller of the gliding vehicle. The method 100 may also be 

implemented as a computer program within another type of computer-readable medium, 
where the various parts of the method 100 constitute corresponding means of the 
computer program. At least some parts of the method 100 can be performed in an order 
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different than that shown in FIG. 1. For example, parts 102, 104, and 106 are shown as 
being sequentially performed in a particular order, although the invention is itself not so 
limited. 

The method 100 is activated during the ascent phase of the vehicle, when the 
5 flight path angle is greater than the guidance start angle ( y^^ ). The guidance achieved by 
the method 100 shapes the trajectory in a vertical plane defined by the x and z axes of 
what is referred to as a P frame, to be controlled so as to minimize drag losses and control 
time-of-flight. The homing commands normal to the x-z plane of the P frame are 
unrestricted throughout the home phase. The P frame in one embodiment is the Earth 
10 local tangent frame at the missile position, the x-axis of which is aligned with the 
missile's current bearing - i.e., the projection of the missile velocity onto the local 
tangent plane. The z-axis of the P frame points along the local plumb-bob gravity vector. 

An energy management term is determined (102). The energy management term 
provides for flying the gliding vehicle along an optimal flight path to conserve energy. 
1 5 The energy management term is defined in the P frame, since it represents management 
of the vertical shaping. In the P frame, the energy management term is given in one 
embodiment as: 

0 (1) 
a 

The scalar a is determined by a controller that seeks to place the missile at the 
20 maximum L/D, subject to the flight path angle follower. The conmianded acceleration 
includes a correction to account for the centrifugal relief associated with the flight over 
the curved Earth. 
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=fiC^,q,S^,^,W,Y.r)" (2) 

where y denotes the current flight path angle relative to the tangent plane having a 
normal vector that passes through the center of gravity of the missile. The C\ is the lift 
coefficient at maximum lift over drag, q is the dynamic pressure, Wis the weight, and y 
is the vertical flight path angle in the x-z plane of the P frame. Furthermore, is the 
optimal vertical flight path angle, V^cef is the speed of the missile relative to the Earth- 
centered and Earth-fixed frame, and R represents the radius of curvature of the Earth geo- 
reference ellipsoid in the direction of travel. Moreover, the value of a for a flat Earth 
assumption can be determined according to a variety of different approaches. 

Next, a homing guidance acceleration term is determined (104), based on a 
selected arrival velocity orientation and desired final target coordinates. The homing 
guidance approach of the method 100 steers the missile to desired final aimpoint 
coordinates (i.e., final target coordinates), and to a desired final velocity orientation. The 
homing guidance acceleration is normal to the velocity vector, because the uncontrolled 
portion along the velocity vector is removed. The azimuth orientation of the final 
velocity is given by an optimized rule set, based on the current bearing off the line-of- 
sight to the target. The target may be updated during the flight, and the rule set allows 
the conmianded azimuth angle to be updated to ensure efficient tums. 

The homing guidance acceleration term is given in one embodiment as: 




(3) 
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Rl is the (arbitrary) frame in which the commanded acceleration to be determined is 
expressed, whereas the origin of the R2 frame provides the reference for the definition of 
the acceleration commands. C,, Cj are gains that may be scheduled for optimization, r 
is the unit vector for the line-of-sight to the target point. S is the current heading error 

5 between the line-of-sight and the current velocity relative to the reference frame R2. v is 
the unit vector along the current velocity relative to the reference frame R2. is the 
unit vector for the desired final velocity orientation relative to the reference frame R2, ju 
is the angle between the current velocity, relative to the origin of the reference frame R2, 
and the desired final velocity orientation, also relative to the origin of the reference frame 

10 R2. V is the magnitude of the missile velocity relative to the origin of the frame R2. 
RGO is the range to go, which is given in one embodiment as: 

RGO^lr/^'-r^'l (4) 

r^J^ is the position vector of the missile relative to the origin of the R2 frame, expressed 

in the Rl frame, rj^^ is the position vector of the missile relative to the origin of the R2 

15 frame, also expressed in the Rl frame. 

The method 100 also determines a bias term (106). The bias term cancels gravity 
acceleration, and controls time-of-flight of the gliding vehicle. That is, the bias term 
provides for correction of gravity acceleration, and provides a mechanism for trajectory 
shaping to control the timcTof-flight. The bias is composed of two terms, the first being 
20 the bias necessary to correct for acceleration due to gravity, and the second being the bias 
added for time-of-flight control. 

The bias term is defined in one embodiment as: 
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^bias " ^gbias ^TOFbias 

On the right-hand side of the equation, the first term is the bias term to correct for 
acceleration due to gravity, whereas the second term is the bias term to control time-of- 
flight. These two terms are themselves expressed in one embodiment as: 



(5) 



^ gbias ' 



0 
0 



-a 



(6) 



a 



TOFbias 



0 
0 



i^TOFbias J 



(7) 



^gR2 is the acceleration relative to the origin of the reference frame R2 due to gravity at 
the current position, expressed in the P frame. Uj^oFbias is the form that the bias term to 
control time-of-flight. 

10 The time-of-flight bias is determined during the flight by using an in-flight time- 

of-flight control approach, as can be appreciated by those of ordinary skill within the art. 
For the in-flight time-of-flight control, the goal is to control the absolute time-of-flight 
issued by the fire control before launch. The in-flight time-of-flight control corrects for 
factors unknown at launch. Such factors can include rocket motor variations, drag 

1 5 variations, and unknown winds, among others. 

During flight, the value of aj^oFbias is desirably updated iteratively with each 
guidance update, based on the current predicted flight time to the target. The predicted 
flight time to the target can be based on an onboard simulation of the vehicle trajectories. 
For each time-of-flight update, the current value of aj^^^^^^j^ is used to estimate the current 
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flight time. The difference of this estimate and the commanded time-of-flight is the 
current time-of-flight error. 

^^errk ~ ^predictk ^command 

If the current time-of-flight error and the previous time-of-flight error (A/^^^^j ) 
5 have different polarities, then their product will be negative. 

/,=A/,.*A/,^,.,<0 (9) 

In this case, the value of aj^^^^^^ that zeros the time-of-flight error lies between the 
current value of Uj^oFbiask the previous value of the bias, aj^0Fbiask-\ - Thus, for the case 
of yj < 0 , the next value of the bias is given as: 

in — ^TOFbiask ^TOFbiask-l /I A\ 

^TOFbiask+\ ~ 2 ^ ^ 

Conversely, if the value of /i > 0 , then both the current and the previous values 
. of the time-of-flight bias lie on the same side of the value which will zero the time-of- 
flight error. In this case, the next value of the bias is changed based on the determined 
error, At^^^ . Thus, for the case of /, > 0, the next iteration of the bias acceleration is: 

1 5 ^TOFbiask+\ ^ ^TOFbiask ^TOF^hrrk ^ ) 

kj^P is a user-selectable gain. The basis for this update approach is that increased 
positive (i.e., downward) bias decreases the flight time to the target. If the predicted 
time-of-flight is short ( Ar^^^^ < 0 ), then the bias is made more negative (i.e., upward) in 

order to slow the flight. 
20 The method 100 next determines the commanded acceleration for the gliding 

vehicle (108). This is based on the homing guidance acceleration term, the bias term, and 
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the energy management temi that have already been determined. The expression of the 
commanded acceleration in the Rl frame in one embodiment is given by: 



P 

emn2 



(12) 
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5 tensor of the form: 
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0 
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Tp2jii is the transformation from the P frame to the /?1 reference frame. K^^^ is a gain 



. The value of the component blending gain scalar 



K^m is selected based on the value of the range-to-go (RGO) to the target. The purpose 
of the gain tensor is to allow the shaping in the vertical plane defined by the x-z axes of 
the P frame to be controlled, so as to minimize drag losses while allowing the homing 
commands normal to this plane to be unrestricted throughout the homing phase. 

10 Once the commanded acceleration has been determined, the method 100 then 

accelerates the vehicle accordingly (1 10), per the commanded acceleration. That is, the 
method 100 guides the gliding vehicle based on the commanded acceleration determined. 
Finally, the method 100 repeats, or iterates, in closed-loop form, as indicated by the 
arrow 112. For instance, the homing guidance acceleration term may be redetermined as 

15 the desired final target coordinates and the commanded azimuth angle are updated. As 
another example, and as has been previously described, the bias term may be iteratively 
determined as the time-of-flight of the gliding vehicle changes. Both such changes to the 
homing guidance acceleration and the bias terms cause the commanded acceleration to be 
redetermined. 

20 As an example of the method 100, according to one embodiment of the invention, 

the performance of an in-flight time-of-flight controller implementing the method 100 is 
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illustrated for an unknown variation of +/- 100 ft/s in the muzzle exit velocity for a gun- 
launched guided projectile. FIG. 2 shows a graph 200 of three trajectories with an in- 
flight time-of-flight controller in accordance with the method 100 active. The fast 
muzzle exit velocity of 2900 fl/s results in an increase in the bias magnitude and a higher 
trajectory. The higher trajectory slows the speed of the projectile to correct for the 
greater initial speed. Furthermore, FIG. 3 shows a graph 300 of the history of the time- 
of-flight commanded bias for the three trajectories, demonstrating the rapid convergence 
of the bias and its stability. 

FIG. 4 shows a rudimentary block diagram of a gliding vehicle 400, according to 
the embodiment of the invention. The gliding vehicle 400 may be a rocket, a missile, an 
aircraft, a projectile, or another type of gliding vehicle. The gliding vehicle 400 includes 
a controller 402 and a movement mechanism 404. The controller 402 controls the 
acceleration of the gliding vehicle 400 in accordance with the method 400 that has been 
described. The controller 402 accomplishes this by determining a commanded 
acceleration as has been described - i.e., based on a homing guidance acceleration term, a 
bias term, and an energy management term. The controller 402 then accordingly 
accelerates the movement mechanism 404 of the gliding vehicle 400. The movement 
mechanism 400 may be a rocket, an engine, or another type of mechanism that provides 
for the accelerated movement of the gliding vehicle 400 through an atmosphere. 

It is noted that, although specific embodiments have been illustrated and 
described herein, it will be appreciated by those of ordinary skill in the art that any 
arrangement is calculated to achieve the same purpose may be substituted for the specific 
embodiments shown. For example, other appUcations and uses of embodiments of the 
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invention, besides those described herein, are amenable to at least some embodiments. 
This application is intended to cover any adaptations or variations of the present 
invention. Therefore, it is manifestly intended that this invention be limited only by the 
claims and equivalents thereof. 
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